
/**
  Function       poleOut
  @author        dxr
  @date          2021.6.25
  @brief         舵机杆放出 从pos1度转出到pos2度
  @param[in]     int pos1, int pos2
  @retval        void
*/
void poleOut(int pos1, int pos2) {
  for (int i = pos1; i <= pos2; i++) {
    pole.write(i);
    delay(15);
  }
}

/**
  Function       poleIn
  @author        dxr
  @date          2021.6.25
  @brief         舵机杆收回 从pos1度转回到pos2度
  @param[in]     int pos1, int pos2
  @retval        void
*/
void poleIn(int pos1, int pos2) {
  for (int i = pos1; i >= pos2; i--) {
    pole.write(i);
    delay(15);
  }
}
